The Boltzmann-Hamel Equations for Optimal 

Control 



o 

O ; Jared M. Maruskin and Anthony M. Bloch 

| ^ . Department of Mathematics, The University of Michigan 

G\ 
(N 

' Abstract 

q 

J3 ■ We will extend the Boltzmann-Hamel equations to the optimal control setting, 

c3 ■ 

producing a set of equations for both kinematic and dynamic nonholonomic optimal 
control problems. In particular, we will show the dynamic optimal control problem 
can be written as a minimal set of 4n — 2m first order differential equations of 
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1 INTRODUCTION 



1 . 1 Overview 

Quasi-velocity formulations, such as Maggi's equation and the Boltzmann- 
Hamel equation, have achieved much success in the analysis of nonholonomic 
systems due to their ability to cast the dynamical equations of motion in a 
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form requiring fewer equations, see (11 01 ). (Il3l ). and (llll ). For an n degree of free- 



dom system with m nonholonomic constraints, 2n + m equations of motion are 
required if one uses the fundamental nonholonomic form of Lagranges equa- 
tion. 2n differential equations for the system state, and m algebraic relations 
that must be solved for the multipliers. However, if quasi- velocity techniques 
are employed, the system can be written as a system of 2n — m first order 
differential equations. 



The standard approach to optimal control problems is to use Lagrange Multi- 
pliers. Under certain conditions, the optimal control problem can be reformu- 
lated as a vakonomic (variational nonholonomic) problem (J3|). One can further 
analyze optimal control problems with Pontryagin's Maximum Principle, see 
(J2|), (J5|), or (Jl|). Solutions to the kinematic optimal control problems, where 
one has direct control over a number of the velocities, can be expressed using 
2n + m equations of motion; whereas solutions to dynamical optimal control 
problems, where one has acceleration controls, can be expressed with An + m 
equations of motion. Some geometric aspects of this system have been dis- 
cussed in ()6|). In this paper, we extend quasi- velocity techniques to optimal 
control problems with nonholonomic constraints. We show how to write the 
optimal control equations for kinematically actuated systems as a system of 
2n first order differential equations (a savings of m equations) and the optimal 
control equations for dynamically actuated systems as a system of 4n — 2m 
first order differential equations (a savings of 3m equations). 
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1.2 Summation Convention 



To aid in notation, we will invoke the summation convention throughout 
this paper. Greek letters («,/3, 7, ...) run over the constrained dimensions 
1, . . . , m. Capital letters (A, B,C, . . .) run over the unconstrained dimensions 
m + 1, . . . , n. Lower case letters (a, b,c, . . .) run over all dimensions 1, . . . , n. 



2 QUASI- VELOCITIES AND VARIATIONS 



In this section we will present the basic background on nonholonomic con- 



straints and quasi-velocities. We will discuss the 



Dasic properties of this con- 



nection and derive the transpositional relations, (11 01 ). (Il3l ). 



2.1 Nonholonomic Constraints and Quasi- Velocities 



Let Q be the configuration manifold of our system, with dim Q = n and TQ its 
corresponding tangent bundle (our phase space). A mechanical Lagrangian is 
given by L : TQ — > R, usually taken to have the form L(q, q) = g^q 1 ^ — V(q) 
where gij is the kinetic energy metric and V(q) is a potential term. 

We further suppose our system is subject to m linear scleronomic (time inde- 
pendent) nonholonomic constraints, i.e. constraints of the form: 

af(g)g* = (1) 

Define now a vector space isomorphism on the tangent space, with inverse 
transformation The first m rows of are taken to agree with the con- 
straint matrix, i.e. ^1(q) = af(l)- The remaining rows can be choosen freely, 
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so long as the resulting matrix \l/ is invertible. The transformation \1/ can be 
viewed as a change of basis: 

where the new basis is referred to as the quasi-basis. The velocity of the system 
v G T q Q can be expressed in terms of the ordinary or quasi-basis as follows: 

where the components w- 7 are the quasi-velocities. Basis vectors transform as: 

9 d . d Ti d 
= <J> and = vfr 

ddi J dq l dq i 3 d9i 

Finally, one defines a set of n one-forms, dual to the quasi-basis: 

d6 j = ^Idq 1 

Even though this notation is found in the literature, it is really a notational 
misnomer, as the one forms dd 3 are not exact. 

2. 2 Variations 

Definition 1 Consider a curve ^(t) : [a, b] — > Q. A proper variation 0/7(2) is 
a differentiable function q(s, t) : [—£, e] x [a, b] — > Q that satisfies the following 
conditions: 

(1) g(0,t)= 7 (i), We [a, 6] 

(ii) q(s,a) = j(a) and q(s,b) = 7(6), Vs G [-e,e]. 

Definition 2 TTie infinites simal variation Sq(t) corresponding to the varia- 

dq{s,t) 



tion q(s,t) is the vector field defined along 7(2) by 5q(t) 

os 



s=0 



4 



We will further assume the variations to be continuous and contemporaneous. 
Continuity of the variations implies that the Lie Derivative C q Sq = vanishes 
identically. Contemporaneous variations occur without the passage of time. 
The infinitessimal variations, when expressed in terms of the quasi-basis, are 
given by 59 j (t) = ^ J i Sq i . 



2. 3 The Transpositional Relations 



A fundamental ingredient for understanding nonholonomic variational prob- 



lems is the following set of transpositional relations (see (jlOl ). (1131 )) 



Theorem 1 (First Transpositional Relations) Utilizing the shorthand d 
d/dt, 5 := d/ds, we have: 



(dSq* - ddq^i = (d56 j - 5d6 j ) + i 3 ab u a 86 b (2) 

f d^> s d^ s 1 . . 

where 'yL. are the Hamel coefficients 7* = < — — — — > $1<H. 

lab JJ Ipq | Q q3 Q ql I P q 

The left hand side of (2) is no more than d8^(C q 8q); and, therefore, for con- 
tinuous variations, is identically zero. We therefore have the following: 



Corollary 1 For proper, continuous variations, variations of the quasi-velocities 
can be related to variations of the quasi- coordinates as follows: 



5u j = d56 j + y ab u a 59 b (3) 



Therefore, due to the nonintegrability of the constraint distribution (7? 7^ 0, 



a 



1 , . . . , m) , one cannot o 



Dtain closure in the quasi-coordinate space, even at 



the differential level ((lid). (Il3[)). One must choose between 5u a = or dSQi 



0. The correct dynamical equations of motion are obtained if one chooses the 



5 



variations so that they obey the Principle of Virtual Work, 58^ = 0. If one, 
on the other hand, choose the variations to satisfy 5u a = 0, one would obtain 
trajectories that satisfy Hamilton's Principle. Such trajectories are referred to 
as the vakonomic motion of the system, a term introduced by Arnold. 

Definition 3 The associated quasi- acceleration, a\ and quasi-jerk, f, are de- 
fined to be a 1 = u l and f — a 1 . 

A direct coordinate calculation shows: 

Theorem 2 (Second Transpositional Relation) For continuous variations, 
we have 5du t = d5u t . Equivalently, 8a l = d(5u l )/dt. 



3 THE BOLTZMANN-HAMEL EQUATIONS 



We will derive the Boltzmann-Hamel equations for nonholonomic mechanics 
directly from variational principles. A more algebraic derivation of these equa- 



tions is given in (jlOl ). We will begin with the Lagrange-D 'Alembert Principle: 



Definition 4 (Lagrange-D'Alembert Principle) The correct dynamical equa- 
tions of motion are the ones which minimize the action I — / L[q, q) dt, 

J a 

where L(q, q) is the unconstrained mechanical Lagrangian and the variations 
are chosen to satisfy the Principle of Virtual Work. 

Let Jz?(q, u) = L(q,q(q,u)) be the re-expression of the unconstrained La- 
grangian in terms of the quasi-velocities. Taking variations of the action and 
using the first transpositional relations (3), one obtains: 
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„ /■» fas? c , aif t , a 

rb (die d die d& i k „\ rni , 

where is the external applied force and we have defined: 

-^TF = y^^- = ^T— $ i and = 

After applying the Principle of Virtual Work, 59 a = 0, the remaining n — m 
variations 58 1 can be taken to be independent, and we obtain the Boltzmann- 
Hamel equations for nonholonomic mechanics: 



d dl£ die die , K ^ 

dtd^ ~ W - d^ lKlU =Ql (4) 

q l = $W (5) 



One must use the unconstrained Lagrangian for these equations. After the 
partial derivatives are taken, one then applies the constraints u a = 0. The 
Boltzmann-Hamel equations (4)- (5) are a minimal set of 2n — m first order 
differential equations for the n q l, s and the n — m u s. 



4 KINEMATIC OPTIMAL CONTROL 



In this section we will present a quasi-velocity based method for kinematic 
optimal control problems, where one has direct controls over the velocities. As 
an example, we will work out the optimal kinematic control equations for the 
falling rolling disc. 
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4-1 Theory 



For a general affine kinematic control system subject to m nonholonomic con- 
straints, the following system is typically specified: q 1 = X}(q)w I , where the w 1 
are the n — m controls and X}(q) is the i-th component of the J-th independent 
control vector field. Taking the m constraints as the first m quasi-velocities: 



one can, wlog, take the controls as the remaining independent quasi-velocities: 



With this choice, the control vector fields are thus identifies with the last n — m 
columns of $ = \l> _1 , i.e. X\ = $}. 

For a given cost integrand g(q,w), the Kinematic Optimal Control Problem 
is then given by minimizing the cost function I = / g(q, w) dt over all curves 



satisfying (7)- (6) with fixed endpoints q(a) and q(b). 

We now define the quasi-basis so that = af , as usual, and, additionally, 
so that \Pf = b\. Then the constraints can be written u a , and the n — m 
control variables w 1 coincide with the remaining n — m free quasi-velocities 
u 1 . Define now C(q,u) = g(q,w(q,q(q,u))). In our case, we have chosen the 
unconstrained quasi-velocities to coincide with the controls, i.e. u 1 = w 1 , thus 
we will have C(q, u) = g(q, u). 

In order to enforce (6), we must apply the Lagrange Multipliers to the cost 
function before taking variations. In this case, we are selecting Hamilton's Prin- 
ciple, where the cost function is minimized amongst the set of kinematically 



u a = %q l = 0, 



(6) 



w'iq, q)=u I = ^{q l 



(7) 



S 



admissable curves. We then take unconstrained variations of the augmented 
cost function I — (C(q,u) + fi a u a ) dt. Since C(q,u) only depends on the 

J a 

unconstrained quasi-velocities u 1 , we have: 

r b (fin fin \ 
61 = J \^ 5ei+ d^ 5uI + ^ 5ua + ua5 M dt 

Setting the coefficients of the 5fi a terms returns our constraints u a = 0. Leav- 
ing this term off for now, using the transpositional relations (3), and integrat- 
ing by parts yields 

" = f { {w + ^ + ^>') Sf >' - J^ 5e ' - ^} dt 

We thus have the following 

Theorem 3 The Boltzmann-Hamel equations for the kinematic optimal con- 
trol problem are: 



d dC dC dC j s _ T s 



dt du 1 dO 1 du J 



jl s y = -l** + Vhlfs*u s (9) 



d6° du J 

q { = & s u s (10) 



These represent a minimal set of 2n first order differential equations: the n — m 
equations (8) for the unconstrained m 7, s, the m equations (9) for the multipliers 
/io-'s, and n kinematic relations (10) for the q l, s. 

As an interesting aside, if the cost function integrand C(q, u), when expressed 
in terms of the quasi-velocities, is identical to the constrained mechanical 
Lagrangian, then these equations produce the vakonomic motion associated 
with the system. See (J3|) for additional discussion on the coincidence of the 
vakonomic motion (Lagrange's Problem) and the optimal control problem. 
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4-2 Optimal Control of the Heisenberg System 



The optimal control of the Heisenberg system, discussed in (|4|) and ([21), is 
a classical underactuated kinematic control problem. Local coordinates are 
given by q = (x, y, z). For this system, one has velocity controls w\ = x and 
w 2 — y and the motion is subject to the nonholonomic constraint z = yx — xy. 
The control velocity field is therefore given by: 



q = Xiw 1 + X 2 w' 



where X\ = (1, 0, y) T and X 2 = (0, 1, —x) T . Using these controls, one seeks to 
steer the particle from the point (0, 0, 0) at time t — to the point (0, 0, a) at 

1 fT . . 

time T > 0, while minimizing the functional I = — J ywl + w^j dt. 

We will derive the equations of motion which yield this solution path via 
the vakonomic form of the Boltzmann-Hamel equations. We choose quasi- 
velocities: U\ = yx — xy — z, u 2 = x, and m 3 = y. Notice the quasi-velocities 
u 2 and W3 coincide with the control velocities. The transformation matrices \P 
and $ are given by: 





~y 


—x 


-1 " 




' 1 





m = 


1 








and $ = 





1 




_o 


1 







-1 y 


—x 



The nonzero Hamel coefficients are 723 = —732 = 2. Expressing the integrand 
of the cost function in terms of quasi-velocities yields C = — (u\ + u t) ■ ^ ne 
kinematic optimal control Boltzmann-Hamel equations (8)-(10) immediately 
produce the following set of first order differential equations: 



x = u 2 
ii 2 = —2fxu 3 



y = u 3 

U 3 = 2/iW 2 



z = —u 2 + yu 2 — xu 3 
fi = 
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where = /x(0) is an arbitrary constant that can be choosen such that the 
solution trajectory reaches its final destination point. The top equations are 
a reiteration of the control field q = Xiw 1 + X 2 w 2 = Xiu 2 + X 2 u 3 and the 
bottom equations produce the optimal control. 

4-3 Optimal Control of the Vertical Rolling Disc 

The generalized coordinates of the vertical rolling disc are given by q = 
(x,y,9,4>), where (x,y) is the contact point of the disc and the x — y plane, 
is the angle the disc makes with the x-axis, and is the angle a reference 
point on the disc makes with the vertical. Assume we have the kinematic 
controls W\ — 9 and w 2 = 0, and that the motion is subject to the nonholo- 
nomic constraints x — cos(<ft)9 = and y — sm(<fr)9 = 0. This gives rise to 
the control vector field q = Xiw 1 + X 2 w 2 where Xi = (cos (j), sin 0, 1,0) T and 
X 2 = (0,0,0,1) T . 

We wish to steer the disc between two points while minimizing the cost 

1 r b 

functional - / (w 1 + w 2 ) dt. We choose quasi-velocities U\ = x — cos(0)#, 

2 Ja 

u 2 = y — sin(0)#, 113 = 9, and M4 = 0, so that the transformation matrices \P 
and $ are given by: 

1 COS0 0" 

1 sin0 
10 
1 

The Hamel coefficients are: 734 = sin0 = —743 and 7| 4 = — cos0 = —743. 
In terms of the quasi-velocities, the integrand of the cost function becomes 
C(q,u) = + The Boltzmann-Hamel equations (8)-(10) then produce 
the following set of first order differential equations: 



1 
1 





COS0 

■ sin 

1 

1 
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^3 = (a*2 cos0 — Hi sin (p)u4 fi\ = i = cos(0)u 3 9 = U3 
«4 = (/Ui sin0 — /i 2 cos0)m 3 /i 2 = ?/ = sin(0)-u 3 = w 4 

^ Kinematic Optimal Control of the Falling Rolling Disc 

The falling rolling disc can be described by the contact point (x, y) and Clas- 
sical Euler angles {<p,9,ip), as shown in Figure 1. We will take the coordinate 
ordering (0, 9, ip, x, y). 




y 



Fig. 1. Euler Angles of the Falling Rolling Disc 

Suppose we have direct control over the body-axis angular velocities w\ = 
Ud := (frsinO, w<i = 9, and W3 = Q := (ft cos 6 + ip (in the e^, eg, and 
e^ directions, respectively (see Fig. 1)), and the system is subject to the 
nonholonomic constraints x + rip cos <p = and y + rip sin <p = 0. We wish 
to steer the disc between two points while minimizing the cost functional 
7 [7] — - [Wi + w\ + w\ ) dt. We will choose as quasi-velocities u\ = <p sin 9, 
U2 = 9, U3 = <fi cos 9 + ip, U4 = x + rip cos <p, and U5 = y + rip sin <p. The quasi- 
velocities {ui,u 2 ,u 3 ) = (ud,9,Q) represent the angular velocity expressed in 
the body-fixed frame, and are coincident with the kinematic controls. These 
are not true velocities (like the Euler Angle Rates), as they are non-integrable. 
The nonholonomic constraints in terms of these variables are M4 = M5 = 0. 
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The transformation matrices are 



sin# 

















1 











cos 6 





1 














r cos 4 


> 1 











r sin d 





1 



and 



csc 6 
10 
-cote 1 
r cos <p cot 9 — rcos0 1 
r sin 6 cot 9 — r sin <A 1 



The nonzero Hamel-coefficients are 7^ = — cot 6* = — j\ 2 , 7^ = 1 = —712, 
7i3 = r s ^ n 4* csc ® = — 73D an( i 7i3 = ~ r cos csc ^ = — 73i- 

Written in terms of the quasi-velocities, the integrand of the cost function is 
C(q,u) = \{u\ + u\ + W3). The kinematic optimal control Boltzmann-Hamel 
equations (8)-(10) give us a minimal set of 10 first order differential equations: 



iii = U2U3 — U\U2 cot 6 — r(/i 4 sin — /is cos 0) csc Ou^ 

u 2 — u l c Ot 9 — U1U3 

ii 3 = r(fj,4 sin d> — /i 5 cos 0) csc 9u\ 
/i 4 = 0, /i 5 = 

d> = csc6ui, 6 — 1*2, ^ = — cot + M3 

A = r cos </> cos 0«i — r cos 0^3, y = r sin cot #wi — r sin <f)Us 



5 DYNAMIC OPTIMAL CONTROL 



In this section, we will derive a set of Boltzmann-Hamel equations for the 
dynamic optimal control problem, which is normally a fourth order system. 
We will present a minimal set of 4n — 2m first order differential equations that 
produces the optimal control, and then discuss examples. 
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5.1 Boltzmann-Hamel Equations for Optimal Dynamic Control 



Given a nonholonomic mechanical system with n—m independent acceleration 
controls, it can be recast into the form given by the dynamical Boltzmann- 
Hamel equations (4)- (5). The dynamical optimal control problem is the prob- 
lem of finding solution curves between two fixed points {q{a), q(a)) and (q(b), q(b)) 

rb 

that minimize the cost function I — / g[q, q, Q) dt. Utilizing (4) and (5), we 

J a 

can rewrite the integrand as an explicit function of the coordinates, quasi- 
velocities, and quasi-accelerations C(q, u, a) = g(q, q(q, u), Q(q, u, a)). 

Since the Boltzmann-Hamel equations no longer depend on the constrained 

quasi- velocities and quasi-accelerations, C(q,u,a) is also independent of u° 

r { dC dC dC 1 

and a a . Taking variations yields: 51 = < Tr~5q l + -= — t5u j + ——r5a J > dt. 

J \dq l du J da J J 

Using the second transpositional relations Theorem 2 for 5a J and then inte- 
grating by parts we obtain 51 = J j ~Q~j5q l + 
ing the parameters 



dC d dC 



du J dt da J 



5u J \ dt. Defin- 



dC d dC 
Kj ~du^~Jtdo7 

and using the first Transpositional relations (3) we obtain: 

61 = I \W ~ ^ + Kjl °r US } W dt 

These variations are not free, but subject to the nonholonomic constraints 
a^q 1 = 0. We form the augmented cost integrand by replacing C(q,u,a) 
with C(q, u, a) + [i a u° ' . Taking variations, the 5[f coefficients recover the con- 
straints. Ignoring these terms, we are left with 51 = 

where the variations are now taken to be unconstrained. Notice the multipliers 
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not the mechanical multipliers, but a multiplier on the cost function 
that enforces Hamilton's Principle. We thus have the following: 



Theorem 4 The Boltzmann-Hamel equations for Optimal Dynamic Control 
are given by: 



dC 

KA - KJlsA uS = Vt1sa uS ( 1 2 ) 



dC 

— - KjrL uS = vt1svU s - fi a (13) 

q { = ¥ s u s (14) 



The optimal control system can therefore be given by a minimal set of An — 2m 
first order differential equations as follows. We have n kinematic relations 
(14), 2n — 2m relations u A = a A and a A = j A , n — m equations for j A 
(given by inserting (11) into (12)), and, finally, m relations for the multi- 
pliers ficr (13). Once the resulting optimal control dynamics are determined, 
the control forces which produce the optimal trajectory are then given by the 
n — m algebraic equations (4). The solution is then found by solving the re- 
lated boundary value problem, with An — 2m prescribed boundary conditions: 
<f (0), u A (0), q^T), u A (T). 



5.2 Dynamic Optimal Control of the Vertical Rolling Disc 



Consider the vertical rolling disc of §4.3 with control torques in the 6 and 
directions. The corresponding dynamical equations of motion (see (|2|)) are: 
!# = W3, \cf) = W4, x = 9 cos 0, and y = 9 sin 0. This is equivalent to a minimal 
set of 6 first order differential equations (the number obtained by using the 
Boltzmann-Hamel equations (4) and (5). 
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We now wish to choose the control forces so as to minimize the cost function 

/ \ (. w 1 + W T) dt. Solving for the controls in terms of the quasi-accelerations 

w 3 = |# = |a 3 and w 4 = |0 = |a 4 , this is equivalent to minimizing the 

action f (-a^ H a"l) dt subject to the nonholonomic constraints. Using the 

J \8 32 / 

dynamic optimal control Boltzmann-Hamel equations (12) and (13), coupled 
with the dynamical equations of motion above, and eliminating the controls, 
we have a minimal system of 12 first order differential equations: 

4 

x = cos (j) u 3 j 3 = - (/ii sin (f> — /i 2 cos </>) W4 

9 

y = sin (f> u 3 j 4 = 16(— ji\ sin (p + /i 2 cos (f))u 3 

Q = u 3 u 3 = a 3 d 3 = j 3 /ii = 
<f) = U4 u 4 = a 4 04 = J4 /t2 = 

By use of quasi-velocities, quasi-accelerations, and quasi-jerks, we have made 
the following simplifications: u\ = U2 = a± = a 2 = Ji = J2 = 0, thereby elimi- 
nating the necessity of 6 of the 18 first order differential equations necessary 
in the standard approach. The solution to this system of differential equations 
yields the optimal dynamic control equations of the vertical rolling disc. It is 
equivalent to the following reduced system 

x = cos 4>6 y = sin <p6 

4 

= — (>u.i sin0 — /i 2 cos (p)(f> <f> = 16(— \i\ sin <f> + /i 2 cos(p)9 
9 

where /ii, /x 2 are constants. 

5. 3 Dynamic Optimal Control of the Free Rigid Body 

Consider dynamic control of the free rigid body, where the generalized coordi- 
nates are given by the Type-I Euler angles (ip, 6, </>). As quasi-velocities, choose 



1(3 



the body-fixed components of the angular momentum u\ — u x — —tp sin + <fi, 
u 2 = ujy = ip cos 9 sin + 9 cos 0, and u 3 = oj z = ip cos 9 cos — 9 sin 0. The 
transformation matrices are given as: 



- sin 9 1 

cos 9 sin cos 
cos 9 cos — sin 



and $ 



sec 9 sin sec 9 cos ( 

cos — sin 

1 tan 9 sin tan 9 cos < 



The mechanical Lagrangian is given as Jzf (q, u) = -^{I xx u\ + I yy ul 2 + I zz u^). 
The nonzero Hamel coefficients are 723 = 1, 713 = —1, 7? 2 = 1, 732 — ~~ 1) 
73! = 1, and j 21 = —1. For notational convenience, define 7732 = I zz — I yy , 
V13 = I xx — Izz, and 7721 = I yy — I xx . Then the Boltzmann-Hamel equations (4) 
produce the Euler Equations: 

IxxUi+r) 32 u 2 u 3 = M x I yy U2+r]i3 u i u 3 = M y I zz u 3 +r] 2 iUiU 2 = M z (15) 

where M x , M y , and M z are the control torques applied about the body fixed 
principal axes. The cost function integrand |(M^ + My + M z ), when ex- 
pressed in terms of quasi- variables, is given by: C = \{I xx a\ + Iy y a 2 + IzzO> 3 + 
2I xx T) 32 a 1 u 2 u 3 + 2I yy 7]i 3 u 1 a 2 u 3 + 2I zz r] 21 UiU 2 a 3 + r}\ 2 u\u\ + r}\ 3 u\u\ + r}\ x u\u 2 2 }. 

The k's (11) are given by: 

Ki = I yy r] 13 a 2 u 3 + I zz r} 2X u 2 a 3 + rjl^uxul + ^Uiul (16) 

-Ixxji - I xx V32U 2 a 3 - I xx rj 32 a 2 u 3 
k 2 = I xx r]32aiu 3 + I zz r]2iuia 3 + r]32 u 2 u l + ??2i M i u 2 (17) 

-Iyyj2 ~ Vl3lyyUia 3 - r] 13 I yy aiU 3 
«3 = IxxV320>lU2 + IyyVl3Uia 2 + V32 U 2 U 3 + ??13 M 1 U 3 (18) 

-Izzj3 - V2ilz z uia 2 - ri 2X I zz a x u 2 
The optimal control Boltzmann-Hamel equations (12) then work out to be: 

k = k x uj (19) 
These provide 3 differential equations for the j's. Let I be the moment inertia 
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tensor with respect to the principal axes basis e x , e y , e z , so that, in dyadic 
notation, I = I xx e x e x + Iy y e. y e, y + I zz e z e z . Let II := I ■ a> be the body axis 
angular momentum, and k, = (k\, k 2 , k 3 ). Then (16)-(18) can alternatively be 
re-expressed as: 

k = nxii+iix(wxii)-n-i-{2w xn + wxn + wx(uxn)} (20) 

Finally, by defining A(u;, Cj) — k + II, the dynamic optimal control equations 
for the free rigid body can be expressed as: 

il = A + Ilx w-Axw (21) 

In addition, we have the kinematic relations 

ip = sec 9 sin 0ii 2 + sec 9 cos 0m 3 (22) 
9 = cos (f>U2 — sin 0ti 3 (23) 
<p = ui + tan#sin0U2 + tan # cos (24) 

as well as the relations iii = a,i, hi = ji. This is a set of 12 first order differential 
equations. Once one solves the corresponding boundary value problem (initial, 
final Euler angles, angular velocities specified), the controls are determins by 
the algebraic relations (15). 

For the special case when the rigid body is spherical one sees from (20) that 
k, = —II and A = 0. Then the Boltzmann-Hamel equations for the optimal 
dynamic control of the free rigid body (21) reduce to c*i = ujxuj. When coupled 
with the kinematic relations (22)-(24) and the algebraic relations (15), the 
optimal control trajectories of the free rigid sphere are produced. Integrating 
once yields the second order system d> = c + u x u:, which coincides with the 



result of (1121 ). See also (|8|). The optimal solution trajectory of the reorientation 



of the rigid sphere from q(0) = (0,0,0), u>(0) = (0,0,0) to the point q(l) 
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Fig. 2. Optimal Dynamic Control of Free Sphere: Euler Angles and Body Fixed 

Angular Velocity with respect to time. 

(tt, -tt/4, tt/5), u>(1) = (0, 0, 0) is plotted in Fig. 2. 



6 CONCLUSIONS 



In this paper, we showed how one can extend quasi-velocity techniques to 
kinematic and optimal control problems. Standard Lagrange Multiplier tech- 
niques for kinematical optimal control problems produce a set of In + m first 
order differential equations: n for the coordinates q\ n for the velocities q l , 
and m for the multipliers \i G . On the other hand, by generalizing the dynamic 
Boltzmann-Hamel equations to the kinematic control setting (Theorem 3), we 
obtain a savings of m first order differential equations, as one no longer need 
solve for the constrained quasi-velocities. Moreover, the differential equations 
for the multipliers (9) are naturally separated from the differential equations 
for the quasi-velocities (8). 

For the dynamic optimal control problem, one typically encounters a fourth 
order system, plus multipliers, which produces a total of 4n + m first order 
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differential equations. The Boltzmann-Hamel form of the equations (Theorem 
4) gives a minimal set of 4n — 2m equations of motion, as one no longer need 
integrate the m constrained quasi- velocities, quasi-accelerations, and quasi- 
jerks, u a = 0, a a = 0, j a = 0, respectively. This approach gives us a total 
savings of 3m first order differential equations. Initial and final conditions are 
then enforced by solving the resulting system of differential equations as a two 
point boundary value problem. 

The authors wish to thank support from NSF grants DMS-0604307 and CMS- 
0408542. 
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